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INTRODUCTION 


A  laser  range  finder  is  Installed  on  the  top  of  a  mast  attached  to  a  land 
vehicle  or  a  helicopter.  This  laser  range  finder  measures  the  distance 
between  itself  and  the  ground  points  on  a  terrain  with  obstacles.  For 
segmentation,  the  edges  of  the  boulder  and  crater  must  be  estimated.  In 
determining  the  near  edges  of  a  boulder  or  the  far  edges  of  a  crater.  It  Is 
necessary  to  locate  the  first  differences  of  the  slopes  of  the  terrain.  This 
Is  equivalent  to  finding  the  second  differences  of  the  terrain  range  points. 
The  threshold  values  of  the  second  differences  can  be  In  terms  of  an  angle  In 
a  vertical  plane.  The  probabilities  of  miss  and  false  alarm  can  be 
ascertained  depending  on  the  method  of  estimation  and  the  scanning  scheme. 

THE  LAPLACIAN  METHOD 

The  Laplaclan  Method  considers  cross-sections  of  terrain  and  looks  for 
changes  In  slope  In  the  azimuth  or  radial  direction.  Since  we  are  only 
considering  one-dlmenslonal  problems,  we  can  write  for  the  measurement 
equation 

Zi  -  d£  +  Vi  (1) 

The  change  In  slope  Is  estimated  by  computing  the  following  sufficient 
statistic: 

A 

®1  -  *1+1  "  2zi  +  zt_i  (2) 

This  Is  a  digital  approximation  of  the  second  derivative,  or  second 
difference,  of  the  range. 

Due  to  the  presence  of  measurement  noise  In  the  calculation  of  Si,  It  Is 
Impossible  to  discern  with  absolute  certainty  whether  a  change  of  slope 


exists.  The  Neyman-Pearson  criterion  provides  a  decision  rule  which  we  nay 
use  to  accurately  detect  edges  of  obstacles  with  a  known  probability  of  waking 
an  error.  To  produce  the  decision  rule,  first  we  must  compute  the  variance  of 
S|^  as  follows.  Vfe  assume  that  the  noise  components  v^  of  the  measurements  are 
Independent  Gaussian  random  variables  with  zero  mean  and  a  variance  of  o^. 
Then,  since  zi^i,  z^,  and  z^.x  are  Independent,  Bqs.  (1)  and  (2)  yield 
var(sx)  -  var(zx+i-2zx+zx+i) 

-  var(zx^.i)  +  var(-2zx)  +  var(zx^x) 

"  +  4o^  +  o^  ■  6o^  (3) 

Because  s^  Is  a  scalar  random  variable,  the  Neyman-Pearson  criterion 

provides  a  decision  rule  Identical  to  that  derived  using  hypothesis  testing. 

The  desired  decision  rule  Is 

no  signal  If  -T  <  s^  <  T 

DECISION^  -  (4) 

presence  of  signal  If  s^  Is  otherwise 

where  T  Is  the  threshold  In  the  decision  process  which  can  be  determined  from 

the  equations 

Pp  -  2*[-T/^5^]  (5) 

Pm  -  ♦((T-u*)/^]  (6) 

where 

♦(z)  -  1/^  /*  e-«^/2  da  (7) 

It  Is  noted  that  the  magnitude  of  s^  Is  not  estimated  the  Laplaclan  Method. 
The  quantity  u*  Is  called  the  "minimum  detectable  change  of  slope,"  since  It 
Is  the  smallest  change  of  slope  that  can  be  detected  with  a  miss  probability 
of  Pm  or  lower.  The  quantity  Pp  Indicates  the  probability  of  a  false  alarm. 
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The  miss  probability  Is  the  probability  of  not  detecting  a  true  change  of 
slope  equal  to  u*« 

Typically,  the  standard  deviation  Is  a  known  system  parameter  and  u* 
is  chosen  so  that  suitable  values  of  Pp  and  P^  can  be  obtained*  Table  I  shows 
the  trade-off  of  Pp  vs.  P^  for  different  values  of  the  ratio  These 

values  are  computed  using  Eqs.  (5)  and  (6). 


TABLE  I.  FALSE  ALARM  PROBABILITIES  AND  MISS  PROBABILITIES 
FOR  VARIOUS  T//r  AND  u*//r 
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THE  RAPID  ESTIMATION  SCHEME  AND  COMPARISON  OF  ERROR  PROBABILITIES 

The  variance  of  for  the  Laplaclan  Method  la  usually  too  high  when  a 
change  of  slope  occurs  during  scanning.  An  adaptive  method  called  Rapid 
Estimation  Scheme  is  used  Instead  to  keep  the  variance  lower,  thus  also 
reducing  the  probabilities  of  false  alarm  and  miss.  A  discussion  of  the 
Second  Residual  Method  for  the  Rapid  Estimation  Scheme  is  given  in  the 
Appendix . 

The  different  expressions  for  the  error  probabilities  of  the  two  methods 
are  given  in  Eqs.  (5)  and  (6)  and  reiterated  in  Table  II.  We  see  that  the 
expressions  for  both  methods  are  the  same  except  that  /6o^  appears  with  the 
Laplaclan  Method,  whereas  /S£^2  appears  %rlth  the  Second  Residual  Method. 

TABLE  11.  ERROR  PROBABILITIES 


Method 


Probability  of  False  Alarm 


Laplaclan 
Second  Residual 


pL  m  2^[-T/i/6o^] 
pS  .  2t[-T/.^i:;^i 


F 


Probability  of  Miss  I 

_ I 

pL  .  41(T-u*)//6o2]  I 
M  I 

ps  -  ♦i(T-u*)//sj:;^i  I 


We  know  that  the  Second  Residual  variance  is  less  than  or  equal  to  the 
Laplaclan  variance: 

(8) 

Since  #(z)  is  a  monotonically  increasing  function  and  has  a  negative 
argument  in  all  the  expressions  in  Table  II  (we  assuae  T-u*  <  0),  we  can 
conclude  that 


pS 

F 


(Second  Residual) 


<  P^  (Laplaclan) 


(9) 


(Second  Residual)  <  (Laplacian)  (10) 

M  M 

Figure  1  illustrates  how  the  smaller  Second  Residual  variance  leads  to  smaller 
error  probabilities. 

With  smaller  error  probabilities,  we  expect  the  Second  Residual  Method 
will  have  a  better  performance  over  the  Laplacian  Method. 


MINIMUM  SLOPES  OF  DETECTABLE  OBSTACLES 

In  this  section  we  will  determine  the  threshold  in  edging  of  gradient 
changes  of  obstacles.  These  may  be  detected  using  the  Second  Residual  or  the 
Laplacian  Method. 

Obstacles  may  or  may  not  be  detectable  depending  on  the  change  of  slopes 

of  the  terrain  at  its  edges.  It  will  be  shown  here  that  the  minimum 

detectable  slope  change  depends  upon  a  given  group  of  parameters. 

Figure  2  shows  a  diagram  of  an  obstacle.  C  and  B  are  consecutive  points 
where  laser  beams  emanating  from  laser  range  finder  bounce  off  the  terrain. 

The  slope  of  the  obstacle  is  tan  0,  since  the  slope  between  C  and  B  is  zero. 

The  mast  height  is  b,  the  height  at  which  the  laser  range  finder  is  located. 

Point  D  is  the  estimate  of  the  range  based  on  the  data  at  point  B  and  previous 
points.  Thus,  the  range  of  point  C  is  measured  as  and  point  D  lies  at  a 

range  of  di^2  t  where  di+2  “  HF£+ix*i+i  is  the  prediction  of  the  range  di+2 
from  previous  data.  We  see  that  the  distance  from  C  to  D  is  the  residue, 

apparent  that  the  expected  value  of  rj^4.2  takes  its  minimum  value, 
u*.  From  the  geometry,  the  quantity  tan  0  can  be  computed  by  finding  x/y. 
These  quantities  are  found  as  follows: 
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X  -  u*  sin  3 


y  -  Ap  -  u*  cos  3 


tan  0  ■  x/y  ■  (u*  sin  3)/(Ap  -  u*  cos  3) 


By  extending  the  above  idea,  we  have  two  slopes,  AB  and  BC,  instead  of 


one  in  the  previous  cases  as  shown  in  Figure  3.  The  angle  Y  is  the  difference 


of  the  angle  6  for  slope  BA  and  the  angle  ^  for  slope  CB.  Now  the  slope  of  Y 


becomes 


tan  Y  -  -  ,  (Y  -  »-♦) 

b 


where 


a  ■  u*  sin  (3<-^) 


b  -  (Ap)  cos  ^  -  (Ap)  sin  ♦  cot  (3*-^)  -  u*  cos  (0++) 


sin  (3+-^)  cos  ♦  -  cos  (34-^)  sin  ♦ 

(Ap)  —  -  u*  cos 

sin  (3<-^) 


(Ap)  sin  3 

.  ^1*  gca  ( 3*'^) 

sin  (34-^) 


(Ap)  sin  3  sin  (3+^)  [ - s 


sin^  (3^^)  (Ap)  sin  3  tan  (3^^) 


Combining  the  terms,  we  have 

(u*/t)  tan^  (3*-+) 

tan  Y  - - -5 - - - 

1  +  tan*  (34-^)  “  (u*/t)  tan  ( 3f ♦) 


where 


T  ■  (Ap)  sin  3 


The  quantity  t  is  the  projection  of  the  data  spacing  in  the  direction  of  sin 


If  Eq.  (17)  Is  solved  for  u*/ t,  we  have 


u*/t  -  K(Y,ft4-« 


A  tan  Y  [1  +  tan^  (&♦•♦)] 


(19) 


tan  (&f+)  [tan  (&♦■♦)  +  tan  Y] 

Table  III  gives  the  values  of  K  as  a  function  of  angle  of  detection  Y  and 

the  sum  of  the  elevation  angle  0  and  the  terrain  angle  • 

The  above  equation  can  also  be  derived  from  Figure  4  which  gives 

A 

u*/t  -  K(y,&«-«)  -  [cot  -  cot  (0f(H-Y)]  (20) 


FUNCTION  K  OF  ANGULAR  GEOMETRY 

If  we  can  keep  the  ratio  u*/ t  constant  In  Eq.  (19)  or  (20) ,  then  the 


value  of  KCYi^I'^)  will  be  constant  In  Table  III.  This  can  be  achieved  by 
letting  both  u*//R  and  t//r  be  constant.  First,  we  trill  discuss  the  value  of 
u*//r. 

Table  I  shows  the  values  of  Pp  for  given  threshold  to  noise  ratio  T/^ 
which  guarantees  the  probability  of  detection.  It  also  lists  the  values  of 
for  both  T//r  and  the  signal  to  noise  ratio,  u*/i/R.  For  example,  let  us  take 
T//r  «  1.679  and  u*//r  *  3.  We  have 

Pp  -  0.0932  (21a) 

Pm  -  0.0932  (21b) 

which  are  reasonable  values  for  our  problem. 

The  second  part  Is  to  keep  the  ratio  t/i/r  constant.  This  Is  related 
to  the  scanning  scheme  given  In  the  next  section.  From  Eq.  (18),  we  have 

t/i^  -  (Ap)(sln  6)/i^  “  constant  ■  L  (22) 

Then  the  ratios 

u*/i^  3 

- - K(y,W-«  (23) 

t//r  L 
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TABLB  III.  VALUES  OF  K  AS  FUNCTIONS 
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If  L  Is  chosen  as  4,  Chen  one  will  look  at  Che  polnCs  for  K  •  0.75  in  Table 
III.  If  L  is  chosen  as  1.6,  Chen  one  will  lo<rti  aC  Che  poincs  for  K  -  1.875  in 
Table  III.  For  K  -  0.75,  Che  following  seC  of  angles  appears: 


0f^ 

15* 

e 

0 

25“ 

0 

0 

Y 

3.8* 

6.7“ 

10.2“ 

15.8 

In  summary,  Che  above  value  of  Y  is  guaranceed  Co  be  deCecCed  for  Che 
condl cions 


u*//R  -  3  ,  Pp  -  Pji  «  0.0932  ,  t//r  -  4 

and  Che  variable  8+^  as  llsCed. 


THE  SCANNING  SCHEME 

In  order  for  Che  value  of  L  Co  be  consCanC  in  Eq.  (22),  one  will  Cake  Che 
discreCe  form  in  Figure  5  as 

(Ap)j  sin  01  -  (Ap)2  sin  82  “  *  consCanC  (23) 

If  b  is  Che  heighc  of  Che  masC,  Chen 


sin  61  ■  — 


sin  07  -  — — — 


(24) 


(25) 


Thus,  we  have  in  Figure  4 

(4p)i  ( Ap)2  X 

“  b  “  T 

The  above  equacion  IndlcaCes  chac  Che  spacing  of  Che  horisonCal 
projeccion  is  proporclonal  Co  Che  radial  dlsCances  from  Che  laser  Co  poinCs  on 
Che  horlzonCal  plane.  For  example,  lec  us  Cake  b  ■  2,  Chen 

(4p)i  (Ap)2  ^ 

«^4-«-pi2  ✓4+P22  2 


(26) 


(Ap)^  -  (/4+^)/w*/2  (26) 

For  example,  given  *  0.125  and  L  *  1.6  or  /r  ■■  0.05  and  L  ~  4.0,  in  both 
cases  ue  have  t  >  /RL  ■  0.20.  Then,  from  Eq.  (26),  we  have 

p  2m  5m  10  m  20  m 

dp  0.2828  m  0.5353  m  1.1832  m  2.010  m 

In  this  case  we  may  miss  a  boulder  of  0.2  m  at  2  m  away  or  a  boulder  of  2  m  at 
20  m  away. 

PROBABILITY  OF  OCTECTION  FOR  RANDOMLY  LOCATED  EDGES 

In  the  previous  sections  it  was  assumed  that  range  measurements  were 
available  from  the  range  finder  to  the  exact  vertex  of  an  edge.  This  Is 
represented  by  point  B  In  Figures  2  and  3.  An  edge  Is  defined  here  by  a 
discrete  angular  change  Y*  If  the  range  measurement  falls  exactly  on  an  edge, 
then  only  a  deterministic  value  for  the  residue  u*  In  Eq.  (19)  Is  obtained. 
This,  In  turn,  corresponds  to  a  deterministic  value  for  the  Pd,  probability  of 
detection.  In  which  Pd  ■  1”Pm  with  Pjn  being  given  by  Eq.  (6). 

In  practice,  however,  the  edges  of  objects  might  be  randomly  distributed 
and  the  range  measurements,  in  general,  might  not  fall  exactly  on  an  edge.  A 
more  realisltc  approach,  therefore,  might  be  to  treat  the  range  measurements 
to  be  randomly  distributed  near  an  edge  represented,  for  example,  by  points 
A,  B,  and  C  In  Figure  6.  A  random  residual  u*  would  result  for  given  edge 
angular  change  Y  Instead  of  the  constant  deterministic  value  of  u*  assumed 


previously 


The  probability  of  detection  In  this  case  can  be  calculated  using  Eq*  (6) 


! 


i 

I 

I 


I 

1 


as  a  function  of  the  random  variable  u*: 

—  T-u* 

P(Detectlon| u*)  ■  1  -  P  (Mlsslu*)  ■  1  -  ♦[ - ]  (27) 

From  geometric  considerations.  It  can  be  shown  that  u*  will  range 
approximately  from  u*/2  to  u*  In  Figure  6.  It  can  be  further  assumed  that  the 
distribution  of  u*  will  be  uniform  over  this  range  of  values  which  corresponds 
to  a  purely  random  distribution  of  object  edges  on  a  given  terrain.  Equation 
(27)  can  then  be  used  to  determine  the  total  probability  of  detection: 

P(Detectlon)  ■  P(Det| u*)f(u*)du* 

u*/2 

2  u*  -  - 

-  —  /  P(Det|u*)du* 
u*  u*/2 


2  ,u*  T-u*  - 

u*  u*/2  /g 


(28) 


In  which  f(u*)  equals  uniform  distribution  on  (u*/2  to  u*),  and  u*  Is  given  by 


Eq.  (19). 

Equation  (28)  can  be  solved  as  a  function  of  T,  and  u*  where  u*  Is  a 
function  of  y,  (B+^),  and  x  as  In  Eq.  (19).  As  an  example,  let 

T//R  -  threshold  level  for  detection 

-  2.146;  gives  Pg  •  0.0319  from  Table  I 

/r  -  /6o^  where  o  ■  range  data  noise  level 

*  0.1225  for  a  ■  0.05 

T  -  0.20 

11 


The  resulting  P(Detectloa)  Is  shoim  In  Table  IV  as  a  function  of  the  angle 
change  Y  and  (^4)<  Other  slallar  Inforaatlon  can  readily  be  generated  for 
other  parameter  values  depending  on  the  actual  problem  to  be  solved* 

The  behavior  of  the  minimum  detectable  angular  change  Y  can  be  readily 
determined  from  the  type  of  Information  given  In  Table  IV.  For  example,  by 
requiring  P(Detectlon)  *  0.90  and  letting  ■  15  degrees,  results  In  a 
minimum  detectable  value  of  Y  to  be  about  40  degrees.  This  compares  to  a 
value  of  Y  at  13  degrees  for  the  nonrandom  case  previously  considered  fihere 
the  range  Is  asstned  to  be  measured  directly  to  the  edge  vertex. 

CONCLUSION 

For  an  assigned  probability  of  false  alarm  and  miss,  one  can  determine 
the  signal  to  noise  ratio  and  the  threshold  to  noise  ratio.  If  me  use  a 
special  scanning  scheme  such  that  the  spacing  of  horlsontal  projections  Is 
proportional  to  the  radial  distances  from  the  laser  to  a  horlsontal  plane, 
then  the  function  K  of  angular  geometry  Is  also  constant*  The  detectable 
angle  Y  with  certain  probability  can  be  found  If  K  and  Sf4  are  known.  The 
angles  ^4  are  related  to  the  elevation  angle  S  and  the  terrain  slope  4* 

The  following  results  were  discussed  In  this  report: 

1.  Ability  to  detect  the  change  of  slopes  In  a  terrain  for  navigation  of 
vehicles  or  robotic  platforms. 

2.  Determination  of  the  probability  of  false  alarm  and  the  probability 
of  detection  for  various  signal  to  noise  ratios  and  for  the  case  of  randomly 
distributed  measurements. 
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3.  Determination  of  required  signal  to  scanning  factor  ratios  for 
various  slopes  and  slope  changes.  The  signals  relate  to  the  probability  of 


detection  and  the  scanning  factor  Influences  the  size  of  the  obstacles. 

4.  Computation  of  the  probability  for  detection  of  an  edge  If  the 
reference  directions  of  the  laser  rays  are  uniformly  distributed  over  the 
slopes  near  an  edge  point. 
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LASER 


Figure  5«  Scanning  Factors 


Reference  Directions  of  Laser  Rays  Near  an  Edge  Point 


APPENDIX 


THE  SECOND  RESIDUAL  METHOD 

The  Second  Residual  Method,  elnilar  to  the  case  with  the  Laplaclan 
Method,  considers  cross-sections  of  terrain  and  looks  for  changes  In  slope. 
Here,  however,  a  state  estimation  and  decision  process  Is  used  to  perform  the 
detection.  A  discrete  second  order  linear  tine-varying  system  model  Is  used 
to  estimate  ranges  and  gradients  (slopes)  from  current  and  previous  data.  If 
the  difference  between  a  range  measurement  and  range  prediction  Is  large 
enough,  a  change  In  slope  Is  Indicated  and  a  special  estimation  scheme  Is 
employed . 


THE  SYSTEM  MODEL 


A  stabilized  system  model  for  a  terrain  has  been  proposed.  The  state 
vector  Is 

*1  -  Nl.  Ell^  (Al) 

where  dj^  Indicates  the  1-th  range  and  g^  the  1-th  gradient  (or  slope).  A 
change  of  slope  Is  modelled  by  the  presence  of  an  unknown  Input,  u^,  which 
adds  to  the  gradient  component  of  through  the  Input  matrix.  The  system 
model  Is 


where 


*1+1  “  ^1*1  +  ®ui 


I  b. 


I  0 


1-c 

'll 


I  I 

I  0  I 

B  -  I  I 

i  1  I 
I  I 


(A2) 


and 


where  and  are  the  time  variant  parameters  and  c  is  a  small  non-megative 
real  number  necessary  for  system  stability  while  scanning  Inward  from 
skylines.  The  measurement  equation  is 


*1+1  "  Hxi+1  +  Vi+i  (A3) 

where  H  »  (1>0]  and  is  zero  mean  Gaussian  noise  where 

0  for  all  i  *  j 

E{vlvj}  -  (A4) 

for  all  1  “  j 

Our  problem,  then,  is  to  detect  any  small  nonzero  inputs  u^,  since 
they  represent  a  change  in  slope. 

As  in  the  Laplaclan  Method,  a  sufficient  statistic  is  necessary  to  detect 
the  change  of  slopes.  This  sufficient  statistic  is  called  the  residue, 
as 

*^1+2  “  *i+2  “  HPi+ix*i+i  (A5) 

where  is  optimal  estimate  of  xj+i  given  z^+j,  , ,zi»  It  can  be 

shown  that 

-  (l-c)ui  s  ui  (A6) 
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